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Abstract 

Research in robot control has generated interests in computationally 
efficient forms of dynamic equations for multi-body systems. For a simply 
connected open- loop linkage, dynamic equations arranged in recursive form has 
been found to be particularly efficient. A general computer program capable of 
simulating open-loop manipulator with arbitrary number of links has been 
developed based on an efficient recursive form of Kane’s dynamic equations. 
Also included in the program is some of the important dynamics of the joint 
drive system, i.e., the rotational effect of the motor rotors. Further 
efficiency is achieved by the use of symbolic manipulation program to generate 
the Fortran simulation program tailored for a specific manipulator based on 
the parameter values given. This paper describes the formulations and the 
validation of the program, and it also shows some results. 

Introduction 

In the development of a robotic manipulator, simulation program can be an 
important design tool. It can be used to support detailed mechanical design by 
revealing the constraint forces and torques at different locations during 
certain maneuvers. It can also be applied to test different control laws 
without concerns of deunaging the actual manipulators. If real time simulation 
cam be developed, training of telerobot operators and testing of actual 
control hardware and software can become possible. 

The success of a simulation in providing the useful and accurate 
information depends on the model fidelity, the formulation of equations of 
motion and the numerical solution of the equations. There is no such thing as 
"the" simulation of a dynamical system because the fidelity of the model 
determines what the results are like. There is always room for higher fidelity 
and so there is no end to it. But quite often, a modest increase of model 
fidelity is accompanied by a significant increase in equation complexity and 
numerical difficulty, and thus computation time. To achieve reasonable 
efficiency in the computation, one has to investigate the merits of different 
solution algorithms, different dynamical formulations and different levels of 
model fidelity. Additionally, one has to validate that the prograun is 
correctly representing the model. 

Many researchers have worked on efficient formulations of dynamic 
equations for robot manipulators[2-9] . Most of them model robot as consisting 
of rigid bodies connected together with revolute or translational joints. 
Details of the joint drive systems have been mostly ignored. It is shown in 
[7] that joint drive systems have potentially significant effects on robot 
dynamics auid hence should be included in the model. Also shown in [7] is a 
procedure to obtain the dynamical equations of a robot with a speed-reduction 
drive system from the equations of a direct drive robot. This procedure will 
be followed to develop a more comprehensive robot simulation program. 
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It has been known [2,5,6] that the important aspect of efficient 
formulations is the recursive development of kinematic and dynamic quantities 
to reduce the number of transformations among vector bases. It is also known 
that recursive Lagrange’s formulation is still less efficient than the 
recursive Newton-Euler’s formulations. However, Newton-Euler’s formulation 
will not be advantageous if more complicated model of the system is analyzed. 
Since the program under development is anticipated to be expanded for more 
comprehensive modeling of manipulator systems, Kane’s method is chosen because 
of its systematic features. An efficient formulation has been developed by 
applying recursive schemes in Kane’s equations for a general manipulator 
system. The forward and backward recursions are established based on the 
bounds on the summation signs in the equations. 

If properly developed, it is expected that a customized simulation 
program for a particular manipulator should be more efficient than a general 
purpose simulation program. For the development of simulation program, there 
is always a trade-off between generality and efficiency. But through the 
application of symbolic manipulation to eliminate unnecessary computations 
that occur for a particular model, it is possible to improve simultaneously 
the generality and the efficiency of a simulation program. Symbolic 
manipulation language MACSYMA has been used to develop a program called MSP 
(Manipulator Simulation Program) for manipulators that are made up of a single 
chain of any number of rigid bodies connected by revolute joints. Gear 
reduction effects of some simple joint drive systems are also efficiently 
incorporated in the program following the procedure in [7]. 

Independent formulation and programming of the system kinetic energy and 
the system angular momentum about a base-fixed point on the 1st Joint axis are 
developed for validation purposes. Test cases which involve conservation of 
these quantities have been selected to validate the simulation programs. The 
objective of this paper is to present the formulation involved in the 
development of this program. Computation efficiency and signif icance of gear 
reduction effect are also to be discussed. 

Mathematic Model 

An open chain manipulator with N degrees of freedom as shown in Fig. 1 is 
analyzed for the development of MSP. Each link is driven with a motor and a 
gear reduction mechanism, an example of which is shown in Fig. 2. The base is 
considered fixed in the earth E (assumed to be an inertial reference frame). ^ 
Couples are generated at motors through electromagnetic interactions, and gear 
reductions amplify the resulted moments on the links about the joints. It is 
assumed that the motor rotor and its rigidly attached part is the only massive 
element in a joint drive system that will contribute to the modifications of 
the equations of motion from that of a multibody direct drive system. 

The links are labeled consecutively B 1 to B M starting from the link 

connected to the base. The base is referred to as link B 0 . The ideal revolute 

joints between links are numbered such that joint i connects link B. to link 

B. An orthogonal unit vector basis x., y. and z. fixed in B. is defined in 

such a way that the unit vector z. (i * 1 N) is directed along the axis 

of joint i. A particular configuration called the null configuration of a 
manipulator is one in which relative Joint angles between links are all equal 
to zeros. The joint angles q { (i = 1 N) are positive when right-handed 

rotation from the null configuration about z { occurs. In this paper, the motor 

driving link B. is assumed to be mounted on link B. . and unit vector e is 
1 1-1 — i 

defined to be parallel to the rotation axis of the motor rotor. 
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Formulation of Dynamical Equation 


The following presentation of the formulations will be in terms of 
vectors and dyadics which are quantities independent of unit vector bases and 
can be represented by column and square matrices, respectively, when expressed 
in a particular basis. 


Kane’s dynamical equations! 1] are 


F + F = 0 
r r 


(r = 1 N) (1) 


where F^ and F f are the generalized active and inertia forces associated with 

the r-th generalized speed, respectively. Since the system is holonomic, the 
number of generalized speeds are equal to the number of degrees of freedom. 
Here the generalized speeds are chosen to be simply the derivatives of the 
generalized coordinates. Assuming that the only contributing active forces are 
the motor torques T^, the gravitational forces and the external load on the 

last link, represented by a force F e acting through the mass center and a 
torque T e , one can write 

F r - * ,5, w s> * V * v i* (r - 1 N » (2) 

where is the gear ratio for the r-th joint, M is the mass of i-th link, G 

is the gravitational acceleration vector, and V. and w. are the r-th 

* — i,r -i,r 

partial velocity of B., mass center of B., and the r-th partial angular 
velocity of B., in E, respectively. The generalized inertia forces are due to 

the inertia force and torque associated with each link, and they are 

F r = ~i?1 M i ( — i,r* M _ i?1 V V I| # «|> (r = 1 N) (3) 

* 

where a. and a. are the acceleration of B. and the angular acceleration of B. 

i i A ^ i 

in E, respectively, and I. is the central inertia dyadic of B.. Therefore, 

the dynamic equations become 

N N 

•2, M.(V. • a.) + .2, u >. • (!.• a. + w.x !.♦ w.) 

i-1 i — i,r —i i*1 -i,r =i -i -l =i -i 

N 


«. = I, q. z. 

-i j*1 M j -j 

V. = -2, q.(z.x r®.) 

-i j»1 -j -ji 

w. = z C’ 

-i.r — r r 

V. = (z x r c .) 

“ i , r “ti r 


where r c .. is the position vector from Q. to B. sind 
“ji J i 

pi _ f 1 if i £ r 

q r \ 0 if r > i 

The angular and linear accelerations can be derived as 
i 

a. = .2. q- z. + a’. 

-i j*1 -j -i 

a - = -2, q- (z.x r®.) + a’. 

-i j*1 n j -j -ji -i 


I e 

(r = 1, . . 

• , N) (4) 

equations. 


(i = 

1 N) 

(5) 

(i = 

1 N) 

(6) 

(i = 

1 N) 

(7) 

(i = 

1 N) 

(8) 

(i,r 

= 1 N) 

(9) 

1 as 



(i = 

1 N) 

(10) 

(i = 

1 N) 

(11) 


CW 


where 


( 12 ) 


a’. = £. q.(«. x z. 

-i j*l -j -j 


.) 


i - 1 


a; « * q, -4 (Z. X r®. ) 

= 2', x Hjj + « f x(y. X Lj.)+ j 5 1 qjZj.xf-^ Lj,) (13) 

and r 1 :. is the position vector from Q. to Q.. A left superscript on a time 

differentiation symbol represents the reference frame in which the 
differentiation is to be performed! 1]. With equations (5-13) substituted, the 
equations of motion can be rewritten as 

1 A’ . q. = (i T - T (r = 1 N) (14) 

i-1 ri 'r r r 

where 

z • f . (15) 

— — ri 


A’ .= _ 

n ~r 

N 


f .= .£.[ I. • z. + M. r c . x (z.x r?.) ] 
-ri j*i -j -i j ~rj -i -ij 


(i a r) 


T = 
r 


i, - ». > * r,]> - 1* -cc^ e*> 


a i -f 

i’i = Jr 2 'i + tf i x h' 


(16) 

(17) 

(18) 

(19) 

( 20 ) 


Because of symmetry, only upper triangular terms of matrix [ A* r . ] need to be 

evaluated. The following formulations are used to evaluate the vector quantity 
f .. 


f . .= I . • z . 

—ii -i — i 


(i = 1 N) 


( 21 ) 


ii 

=£< I,- + - c?, e;, » 




- I,.,* g, * c;.,)U - cL.,*.,- 




(i = N-l 1) 

(22) 

h 

-l, * <,5,.-,**, 

) ( ( r*" ) 2 U - r* - r L ] 

;lv -i(i+1) ^ — i(i+1 )— i(i+1) J 




(i = 1 N) 

(23) 

* 

r. 

— i 

-A M i 




■ c*.i * M I * < j ?m i V c id.i> 

(i = N-l 2) 

(24) 


The dyadic quantity £. is a constant in B., i.e, if £. is expressed in terms 
of X,-. z.j basis, the coefficients are constants. Equations (22) and (24) 

are backward recursive formulas that can be evaluated by establishing the 
following: 




* 



= I + M u [(rf u ) 2 y - eL eL. 1 


=N 


~NN - 


^-HU -HH 



= M r 

M "MM 


(25) 

(26) 


where I ™ N is the inertia dyadic of B N relative to Q N - For the off-diagonal 

terms of [A .], a backward recursive formula involving r, i.e., 
r i 
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f .= f, ... + r L , , x (z.x r*) 

r i — (r+1)i — r(r+1) — i — i 


r i - N i • • . , 2 ■> 
1 r = i-1 1 ) 


can be used with f.. being the starting vector that should have been evaluated 
from equation (21). 

A 

For I r , the following forward recursive formulations can be used to 
evaluate the necessary quantities. 


U). 

“1 

■ «i-i* ’A 


a = l... 

■ • , N) 

(28) 

ot\ 
- 1 

- a,<8,x i|) 


(i = 1... 

...N) 

(29) 

u. 

— 1 

A c 

= a. - A. • r.. = u. 4 

=i —n “i-l 

+ A • r L 
-i-1 

(i = 1... 

...N) 

(30) 

A, 

= a’x U + (a>.x U) • ( w. 

“i = -I = - 1 

x y) 

(i = 1... 

. . ,N) 

(31) 


where 

6 i = a’x y + (w.x y)*(w.x y) (i = 1 n) (31) 

The starting values for equations (28-30) are 

y 0 = 0 (32) 

«0 = 0 (33) 

Uq = (34) 

The introduction of dyadic quantity A. is to reduce the overall computation by 

reusing it in two equations in the remaining formulations. The dyadic obtained 
by cross multiplying a vector with a unit dyadic can be represented by a 
skewsymmetric square matrix when it is expressed in a particular unit vector 
basis. This skew symmetric square matrix is commonly encountered when a cross 
multiplication of column matrices is replaced with a matrix multiplication. 


The following backward recursive formulation can be used to evaluate the 
kinetic quantities T.: 

E, * E,., ♦ Ar "jSm'V e kiV m i e h' (l - "- 1 >> '36) 

T. = T. + r. , x p. + L. + [ M. r*. + (. 2 . .M.) r L . ] x u 

-i -i+1 — iO+1) 'n+l -i i -n j-i+1 j — i(i+1) — i 

(i = N-l 1) (37) 

where 

L, = { A,-* 2 %--U) y]> v (i = 1 N) (38) 

and a subscript v next to a dyadic in equation (38) denotes the vector of the 
dyadic, which is formed by summing the cross products of the prefactors and 
the postfactors of all the dyads in the dyadic. The reason for using the 
expression in equation (38) is to reduce computation counts. In fact, L. can 

be expressed in a form identical to equation (20). Conversely, equation (20) 
can be replaced by 

r, = < a ? - ii.~ I (i.:y) yi> v a = i,...,n) (39) 

where the expression in brackets [ ] is the dyadic whose representation in a 
particular unit vector basis is the inertia matrix with half its trace 
subtracted from each diagonal element. The dyadic operations used above follow 
the convention introduced by Gibbs[10] in late eighteen hundreds. 

The starting values for the recursive equations, equations (36) and (37), 

are 

E. = H « V "5, (40) 

i« - M » 4,* <v * i* - 1 * (4D 
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Equations (14) represent the equations of motion of a direct drive 
open-chain system. The modifications to equations (14) for an open-chain 
system with motors and gear reduction mechanisms shown in Fig. 2 are based on 
the difference between generalized inertia forces contributing to these two 
systems . They are [ 7 ] 


(F*) = (F*) + G* (r = 1 N) (42) 

r s r s' r 

where subscript s represents a manipulator system S which has a motor and gear 
reduction mechanism in each link similar to that shown in Fig. 2, while 
subscript s’ represents the manipulator system S’ which has the same mass and 
inertia distribution as system S, but the motor rotors and gear reduction 
mechanisms are considered to be fixed in the links on which they are mounted. 
Here and throughout this paper, the motor driving i-th Joint is assumed to be 
mounted on link B (i=l,...,N). System S’, therefore, represents a direct- 

drive system. The difference terms between these two systems are 



° 

( 

r > 

i 

) 


* 

G = - 

r 

, -fVMfrV *r-r *r> 

( 

r = 

i 

) 

(43) 


i5r.r*‘i J i l( V £,)q, - V»t-1 X 2 r >- £,1 

( 

r < 

i 

) 



With the additional terms added, 

N 

X A 
1 = 1 r 

where 


q ,- - 


M T 
r r 


- T + G 


A .= 
r i 


A’ . + 
r i 


{ 


p 2 j. 

i i 


the dynamic equations for S become 

(r = 1 N) 

(if r * i ) 

(if r = i ) 


(44) 

(45) 


G 

r 


= - (l J 

r r 


a *e 
-r-1 — r 


i?r + 1 


u.J.q.(w. .x z )*e. 

i i i -i-1 — r — i 


(46) 


It can be noticed that matrix [A .] is still symmetric. Hence, only those 

ri 

difference terms in the upper triangle of matrix [A rj ] need to be evaluated. 


Symbolic Manipulation 

Direct numerical approach in evaluating the above equations can be 
inefficient if there are terms involving multiplication with 0 or 1, or 
addition with 0. The use of multi-dimensional arrays in a general purpose 
program further reduces the computational efficiency. These are some of the 
reasons why a general simulation program cannot achieve the highest possible 
efficiency. Symbolic language such as MACSYMA can be applied to eliminate 
these inefficiencies. Theoretically, one can use MACSYMA to derive equations 
explicitly in terms of all joint angles and their derivatives and then to 
reorganize the equations for efficient computation. But for a manipulator with 
high number of degrees of freedom, this requires enormous memory space and CPU 
time, and cannot be optimally simplified because the simplification is limited 
by the capability of MACSYMA. It has been found that the recursive formulation 
as presented above is particularly advantageous because computation is already 
optimized. Only simple symbolic operations need to be applied to generate the 
recursive equations of motion in FORTRAN coding, and hence the computer time 
required for this process is not excessively long. 

Program Validation 

Complete validation of a simulation program is next to impossible. But 
without being subject to some forms of validation, a program cannot be 
trusted. When a program is applied on a reasonably complicated system, one 
cannot rely on simple statements like "the results make sense" as validation. 
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For a manipulator system with 3 or more links, intuition as to its motion when 
subject to certain inputs does not work well at all. A more systematic 
approach need to be adopted. This is a very important subject for the dynamic 
simulation of robots, but it does not seem to attract much attention. The 
approach taken by the authors was to select some conditions under which the 
system will have some scalar quantities, such as energy or measure numbers of 
an angular momentum vector, that are conserved throughout the motion. Since 
there exists a slight possibility that chance may cause errors not to be 
detected, an independently developed program is used to evaluate the 
validation quantities. Formulation of the system kinetic energy, potential 
energy and the system angular momentum about a base-fixed point on the first 
joint axis for validation purposes will be described next followed by the 
description of test cases chosen. 


The kinetic energy formulation for a direct-drive manipulator S’ is 

N N 

K’ = 1 . 2 , A., q.q. (47) 

2 1-1 j - 1 ij 

For a manipulator with gear reduction in its drive system, slight modification 
is required. Consider two manipulator system S and S' as described before. If 
they have the same motion, then the kinetic energies K and K* of systems S and 
S’, respectively, are related by[7] 

N 

K = K* + p.J.q. + p.J.q. <*>. • e.) (48) 

i*1 2 *i i m i M i -1-1 —i v 9 

The potential energy V of the system are due to gravity only, and it is 

v - -,5, M. G • 3 (49) 


There is no difference between the potential energy expressions for S and S’ 
because they have the same mass distribution. The angular momentum vector H’ 


of a direct-drive manipulator S’ about Q 1 is 

H’ = -2, £ r p X (m p E V P ) (50) 

where P is a generic particle in B., 2 represent the summing over all the 

^ j 

particles in B , r p is the position vector from Q 1 to P, and m p and E V P are, 

respectively, the mass and the velocity in E of P. Only the measure number of 
H’ in z. 1 direction is used in the validation process. Comparing the kinetic 

energy formulation with that of H’ , one can obtain 

N 


H’ • z = .£ A q. 
1 i-I 1 i i 


(51) 


where A 1 . can be found in Eq. (15) with r = 1. The angular momenta H and H’ 

about Q of systems S and S’ , respectively, are related by 
n 

H = H’ + .J, p.J.q.e. (52) 

- - i=1 i ill ’ 

Hence, equations (48-52) provide the necessary formulas for the evaluation of 
the conservation quantities. 


The validation cases used are 

I. Conservation of total energy, K+V : 

T =0 (r = 1, .... N) 
r 

II. Conservation of H • z y : 

a. g = 0, T 1 = 0, p 1 = 1, e 1 = z y 

b. g * 0, T 1 = 0, = 1, e t = z 1 = ± G/g 

where g is the gravitational constant. 
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Under conditions described above, many simulation runs of manipulators 
have been performed to validate the program. The results of these runs show 
that numerical variations of the conservation quantities are of the order of 
magnitude that is appropriately correlated to the absolute integration error 
tolerances. Here integration subroutines using Adams-Bashforth-Moulton 
predictor-corrector scheme and using Runge-Kutta-Verner method have been 
separately applied for numerical integration. 

Discussions 

For a general manipulator, the total numbers of operations to obtain A r * 

and liT - T (r, i = 1 , . . . , N) in Eq. (14) for a direct drive manipulator are 
*r r r 

11N(N-1)+150(N-1)-15 multiplications and 7N(N-1 )+119(N-l )-14 additions. 

Table 1 lists the numbers of operations required for each of the equations in 

the evaluation of matrix [A .] and T . The counting of operations follows that 

r l r 

presented in [6]. Notice that unit vector basis transformation has to be 
performed in each recursion step. Here external force and torque applied on 
the last link are not included. Therefore, for a general 6 link manipulator, 
1075 multiplications and 791 additions are required. This is much lower than 
the 1541 multiplications and 1196 additions needed in Method 3 of [2]. For the 
six dof PUMA 600 presented in [9], Our MSP program generates FORTRAN code that 
requires 351 multiplications and 281 additions to perform the computation that 
takes 392 multiplications and 294 additions in [8]. 

Table 1. Number of Operations 


equations 

multiplications 

additions 

(22) 

57(N-1 )-33 

36(N-1 J-2B 1 

(24) 

8(N-1 ) 

7(N-l)-3 

(27) 

11N(N-1)-8(N-1) 

7N(N-1)-4(N-1) 

(28) 

8(N-1) 

5(N-1) 

(29) 

10(N-1) 

6(N-1) 

(30) 

17(N-1) 

13(N-1) 

(31) 

6 ( N- 1 ) 

9(N-1)+1 

(36) 

17(N-1 ) 

13(N-1 ) 

(37) 

20(N-1 ) 

19(N-1) 

(38) 

15(N-1 )+3 

15(N-1)+1 

(40) 

9 

6 

(41) 

6 

5 

TStKI 

11N(N-1)+150(N-1)-1S 

7N(N-l)+119(N-l)-l4 


Adding q.z. to the right hand side of equation (29), equations (28-41) 

together with equation (17) become inverse dynamic formulation for a direct 
drive robot. This inverse dynamic evaluation is similar to algorithm 3 in [6]. 
By applying MACSYMA to the formula, some unnecessary computations can be 
removed. For instance, if N is 6, the number of computation for the 
manipulator with twist angles equal to 0° or 90° is 340 multiplications and 
290 additions compared to 388 multiplications and 370 additions in [6]. For 
the simpler manipulator with r®. and } having only one nonzero element, 

the numbers of computation are 245 multiplications and 204 additions compared 
to 277 multiplications and 255 additions in [6]. The reductions are due to 
some additional multiplications and additions with zero quantities that are 
counted in [6] because the authors of [6] did not actually expand the 
equations for the counting. 

In order to give additional indication of efficiency, the 7 link Robot 
Research Corporation [11] manipulator shown in Fig. 3 with parameters listed 
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in the Appendix is considered. The numbers of operations for the system in the 
form of Eq. (14) are 651 multiplications and 505 additions with effects of 
motor rotors included. The numbers for direct-drive system are 548 
multiplications and 439 additions. Therefore, adding the effects of motor 
rotors requires 103 multiplications and 66 additions, which is about 17% of 
the total computation needed for the direct-drive system. 

In the interest of demonstrating the effect of motor rotors, a constant 
motor torque (T^ 0.625 N-m) is applied on the first joint of the 7 link 

manipulator shown in Fig. 3. Two sets of equations are solved for comparison. 
Set 1 is equation (14), which represents the direct drive system S’ and set 2 
is equation (44), which is the complete equations of system S. The results 
from set 1 are shown in Figs. 4 and 5 while those from set 2 are in Figs. 6 
and 7. The differences of the results are so substantial that it is clear that 
set 1 is not representative of the actual system. 

Among all the additional terms due to motor rotor, the terms p^J.q. 

( i=l N) are most significant due to the large values of p.. Another set 

of equations, set 3, established by adding only p^J. to diagonal elements 

A., of [A’^.l matrix in equations (14), is also solved for comparison. A 

sinusoidal motor torque (T.j= 3.125 cos 0.8IIt kg-m) is applied on the first 

joint of the manipulator. Some of the results from set 2 are shown in Fig. 8 
while the differences of the results between set 2 and set 3 are shown in 
Fig. 9. It is clear that the differences are relatively small in the duration 
of 5 seconds. 



Fig. 3. A 7 Link Manipulator 
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Conclusions 

The initial development of an efficient simulation program for 
telerobot ic manipulators is described. An efficient recursive formulation of 
Kane’s dynamic equations for a class of manipulators which are made up of 
links connected with revolute joints and driven by motors with reduction 
mechanisms is presented. The recursions are established according to the 
summation bounds in the equations. Comparison of operation counts with other 
published formalisms shows advantages of the present approach. Furthermore, 
effects of rotor inertia and speed reduction are included in the formulation 
to yield a more faithful model of the actual system. Symbolic manipulation is 
also applied to generate customized simulation program for additional 
improvement of the computational efficiency. Aside from the discussions on 
efficiency, steps taken to validate the simulation program are presented. 
Finally, simulation results show that effects of rotors in drive system with 
high speed reduction cannot be ignored in the simulation of a manipulator. 
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Appendix 

The parameters of a 7 link Robot Research Corporation manipulator used in the 
simulation from which results are presented in this paper are in the 
following. 

Mass (including motor and speed reduction mechanism): (kg) 


■ifeva 

1 

2 

3 

5 

5 

6 

7 


104.2 

55.4 

28.8 

20.4 

ii. r~ 

4.7 

4.7 


2 

Moment of inertia (including motor and speed reduction mechanism) : (kg-m ) 



I"xx 

Iyy 

TTz 

link 1 

2705 

2705 

0.7 

link 2 

0.4 

0.4 

0.3 

link 3 

0.6 

0.6 

0.2 

link 4 

0.2 

0.2 

0.2 

link 5 

0. 1 

0. 1 

0.04 

link 6 

0.03 

0.03 

0.03 

link 7 

0.03 

0.03 

0.03 


Speed reduction ratio, rotor inertia (including attachment) and rotor axis (in 
link fixed unit vector basis): 



speed ratio 

rotor inertia 
(kg-m 2 ) 

rotor axis 

base 

TB0 

O,0O3 

l 0, 0, 1 1 

link 1 

160 

0.003 

[ 1, 0 , 1 ] 

link 2 

200 

0.0003 

[ 0, 1 , 0 ] 

link 3 

200 

0.0003 

[ 1 . 0 , 0 ] 

link 4 

200 

0.0002 

[ 0, 1 , 0 ] 

link 5 

200 

0.0002 

[ 1 . 0, 0 ] 

link 6 

160 

0.0002 

[ 0, 1 , 0 ] 


Joint to mass center position vector (m) r®. , i-1 7 : 



~TT 7 Z 

link T" 

— 0 0 0~ 

link 2 

0 0 0 

link 3 

0 0 0 

link 4 

0 0 0 

link 5 

0 0 0 

link 6 

0 0 0 

link 7 

0 0 0 


Joint to Joint position vector (m) , i=l 6 : 



X 7 2 

link - 1 

link 2 
link 3 
link 4 
link 5 
link 6 

0.0 0.0 0.5 

0.3 0.1 0.0 

0.1 0.0 0.3 

0.3 -0.1 0.0 

0.08 0.0 0.4 

0.19 -0.08 0.0 
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